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DESCRIPTION 

LEGGED MOBILE ROBOT AND CONTROL SYSTEM THEREOF 

TECHNICAL FIELD 
[0001] This invention relates to a legged mobile robot and a control system 
thereof, more particularly to a legged mobile robot whose feet are provided with 
bendable toes. 

BACKGROUND ART 

[0002] Techniques have previously been proposed for providing the feet of a 

legged mobile robot with bendable toes. Examples of this type of legged mobile robot 
include, for example, the technology set out in Patent Reference 1, In the technology 
according to Patent Reference 1, a configuration is adopted which provides a vertically 
rotatable toe formed at the fore end of the foot and a lock mechanism for locking 
rotation of the toe at the position where the bending angle of the toe is zero degree 
(substantially horizontal) and ensures the required contact area at floor contact by 
locking the rotation of the toe before the leg touches down and the toe is retractively 
rotated (bent) during toe-off by releasing the lock before the leg lifts off. 
Patent Reference 1: Japanese Laid-open Patent Application No. 2003-236777 
(particularly paragraphs 0011, 0012, Figure 2 and Figure 10) 

DISCLOSURE OF THE INVENTION 
25 Problems to be solved by the invention 

[0003] However, in the aforesaid prior art according to Patent Reference 1, 
because the toe is in a free (rotatable) state when the leg lifts off, the toe resumes its 
original position (zero degree bending angle position) after liftoflf, so that the toe is 
liable to contact the floor to make the robot's posture unstable. 
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[0004] Moreover, when a long tiptoe standing period occurs at the late stage of the 
supporting leg, such as during stair climbing, a problem arises in that stable posture 
control is difficult to achieve if the toe is in the free state. 

[0005] Therefore, the object of this invention lies in overcoming the aforesaid 
5 problems and in providing a legged mobile robot and a control system thereof which 
prevents posture destabilization by the toes contacting the floor immediately after liftoff 
and improves stability during tiptoe standing. 

Means for solving the problems 

10 [0006] In order to achieve the object, as recited in claim 1 mentioned below, this 
invention is configured to have a legged mobile robot having a body and legs whose 
upper ends are connected to the body and whose lower ends are each connected to a foot 
to be movable when the legs are driven, characterized in that the foot comprises a foot 
main body connected to each of the legs, a toe provided at a fore end of the foot main 

15 body to be bendable with respect to the foot main body, and a bending angle holder 
capable of holding a bending angle of the toe in a bendable range of the toe. 
[0007] Further, as recited in claim 2 mentioned below, this invention is configured 
to fiirther include a bending angle change suppressor that suppresses change of the 
bending angle of the toe. 

20 [0008] Further, as recited in claim 3 mentioned below, this invention is configured 
such that the toe is made continuous with the foot main body and is made of an elastic 
material that bends with flexing. 

[0009] Further, as recited in claim 4 mentioned below, this invention is configured 
such that the toe is connected to the fore end of the foot main body through a rotational 
25 shaft capable of rotating about a pitch axis. 

[0010] Further, as recited in claim 5 mentioned below, this invention is configured 
to fiirther include an urging means for urging the toe in a direction of restoring it to an 
initial position. 

[0011] Further, as recited in claim 6 mentioned below, this invention is configured 
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such that the bending angle holder comprises a friction brake. 

[0012] Further, as recited in claim 7 mentioned below, this invention is configvired 
such that the bending angle change suppressor comprises a damper. 
[0013] Further, as recited in claim 8 mentioned below, this invention is configured 
5 such that the bending angle holder and the bending angle change suppressor comprise a 
friction brake whose frictional force is made adjustable. 

[0014] Further, as recited in claim 9 mentioned below, this invention is configured 
such that the bending angle holder and the bending angle change suppressor comprise a 
damper. 

10 [0015] Further, as recited in claim 10 mentioned below, this invention is 

configured to have a system for controlling a legged mobile robot having a body and 
legs whose upper ends are connected to the body and whose lower ends are each 
connected to a foot to be movable when the legs are driven, the foot having a foot main 
body connected to each of the legs and a toe provided at a fore end of the foot main 

15 body to be bendable with respect to the foot main body, characterized by a bending 
angle holder capable of holding a bending angle of the toe in a bendable range of the toe, 
and a bending angle controlling means for operating the bending angle holder to control 
holding and releasing of the bending angle of the toe, the bending angle controlling 
means holding the bending angle of the toe at a first time point which is a liftoff time of 

20 the leg from a floor or earlier thereof, and releasing the held bending angle of the toe at 
a second time point after the leg has lifted off the floor to restore the toe to a initial 
position. 

[0016] Further, as recited in claim 11 mentioned below, this invention is configured 
to further include a gait generating means for generating a gait of the robot, and the 
25 bending angle controlling means determines the first time point and the second time 
point based on the generated gait. 

[0017] Further, as recited in claim 12 mentioned below, this invention is configured 
to further include a bending angle detecting means for detecting the bending angle of 
the toe, and a gait generating means for generating a gait of the robot, and the bending 



angle controlling means determines the first time point based on the detected bending 
angle and determines the second time point based on the generated gait. 
[0018] Further, as recited in claim 13 mentioned below, this invention is configured 
such that the bending angle controlling means holds the bending angle of the toe at a 
5 third time point during liftoff of the leg from the floor, which is later than the second 
time point, and releasing the held bending angle of the toe at a fourth time point, after 
the leg has landed on the floor, which is earlier than the first time point at a next time. 
[0019] Further, as recited in claim 14 mentioned below, this invention is configured 
to further include a gait generating means for generating a gait of the robot, and the 
10 bending angle controlling means determines the first to fourth time points based on the 
generated gait. 

[0020] Further, as recited in claim 15 mentioned below, this invention is configured 
to further include a bending angle detecting means for detecting the bending angle of 
the toe, and a gait generating means for generating a gait of the robot and the bending 
15 angle controlling means determines the first and third time points based on the detected 
bending angle, and determines the second and fourth time points based on the generated 
gait. 

[0021] Further, as recited in claim 16 mentioned below, this invention is configured 
to further include a bending angle change suppressor that suppresses change of the 
20 bending angle of the toe, and the bending angle controlling means releases the held 
bending angle of the toe at the second time point to gradually restore the toe to the 
initial position by operating the bending angle change suppressor to reduce the bending 
angle progressively. 

[0022] Further, as recited in claim 1 7 mentioned below, this invention is configured 
25 to further include a bending angle change suppressor that suppresses change of the 
bending angle of the toe, and the bending angle controlling means operates the bending 
angle change suppressor from the fourth time point to the first time point at the next 
time to control a floor reaction force acting to the robot through the foot. 
[0023] Further, as recited in claim 18 mentioned below, this invention is configured 
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to further include a bending angle change suppressor that suppresses change of the 
bending angle of the toe in accordance with a predetermined resistance characteristic set 
with respect to angular velocity of the bending angle, and the bending angle controlling 
means manipulates a position or posture of the foot from the fourth time point to the 
first time point at the next time to regulate the bending angular velocity of the toe, 
thereby varying magnitude of resistance produced by the bending angle change 
suppressor to control a floor reaction force acting to the robot through the foot. 
[0024] Further, as recited in claim 19 mentioned below, this invention is configured 
to fiirther include a bending angle change suppressor that suppresses change of the 
bending angle of the toe; a bending angle detecting means for detecting the bending 
angle of the toe, and a floor shape estimating means for estimating shape of the floor on 
which the foot is based on at least the detected bending angle, and the bending angle 
controlling means operates the bending angle change suppressor from the fourth time 
point to the first time point at the next time based on at least the estimated shape of the 
floor to control a floor reaction force acting to the robot through the foot. 

Effects of the invention 
[0025] Since the legged mobile robot recited in claim 1 is configured such that the 
foot comprises a foot main body coimected to each of the legs, a toe provided at a fore 
20 end of the foot main body to be bendable with respect to the foot main body, and a 
bending angle holder capable of holding a bending angle of the toe in a bendable range 
of the toe, the bending angle at the time of liftoff can continue to be held after liftoff, 
whereby the robot can be prevented from becoming unstable owing to the toe contacting 
the floor immediately after liftoff. In addition, stability during tiptoe standing can be 
25 enhanced ovAng to the fact that the bending angle of the toe can be held (the toe can be 
locked) also during tiptoe standing. 

[0026] Further, since the legged mobile robot recited in claim 2 is configured to 
further include a bending angle change suppressor that suppresses change of the 
bending angle of the toe, in addition to the effects mentioned above, occurrence of 
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overshooting and vibration can be prevented when the toe is restored to the initial 
position. 

[0027] Further, since the legged mobile robot recited in claim 3 is configured such 
that the toe is made continuous with the foot main body and is made of an elastic 
5 material that bends with flexing, in addition to the effects mentioned above, the 
structure of the foot can be made simple. 

[0028] Further, since the legged mobile robot recited in claim 4 is configured such 
that the toe is connected to the fore end of the foot main body through a rotational shaft 
capable of rotating about a pitch axis, in addition to the effects mentioned above, the 
10 contact area during the tiptoe standing period can be maintained constant irrespective of 
how large or small the bending angle. 

[0029] Further, since the legged mobile robot recited in claim 5 is configured to 
fiirther include an urging means for urging the toe in a direction of restoring it to an 
initial position, in addition to the effects mentioned above, restoration of the toe to the 
1 5 initial position can be performed rapidly. 

[0030] Further, since the legged mobile robot recited in claim 6 is configured such 
that the bending angle holder comprises a friction brake, it can obtain the same effects 
as those mentioned above. 

[003 1] Further, since the legged mobile robot recited in claim 7 is configured such 
20 that the bending angle change suppressor comprises a damper, it can obtain the same 
effects as those mentioned above. 

[0032] Further, since the legged mobile robot recited in claim 8 is configured such 
that the bending angle holder and the bending angle change suppressor comprise a 
friction brake whose frictional force is made adjustable, in addition to the effects 
25 mentioned above, the structure of the foot can be simplified. 

[0033] Further, since the legged mobile robot recited in claim 9 is configured such 
that the bending angle holder and the bending angle change suppressor comprise a 
damper, in addition to the effects mentioned above, the structure of the foot can be made 
simpler. 
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[0034] Further, since the legged mobile robot control system recited in claim 10 is 
configured to have a bending angle holder capable of holding a bending angle of the toe 
in a bendable range of the toe, and a bending angle controlling means for operating the 
bending angle holder to control holding and releasing of the bending angle of the toe, 
5 the bending angle controlling means holding the bending angle of the toe at a first time 
point which is a liftoff time of the leg from a floor or earlier thereof, and releasing the 
held bending angle of the toe at a second time point after the leg has lifted off the floor 
to restore the toe to a initial position, the bending angle at the time of liftoff can 
continue to be held after liftoff, whereby the robot can be prevented from becoming 
10 unstable owing to the toe contacting the floor immediately after liftoff. In addition, 
since the first time point is set to be earlier than the liftoff time of the leg, stability 
during tiptoe standing can be enhanced owing to the fact that the bending angle of the 
toe can be held (the toe can be locked) also during tiptoe standing. 

[0035] Further, since the legged mobile robot control system recited in claim 11 is 
15 configured to further include a gait generating means for generating a gait of the robot, 
and the bending angle controlling means determines the first time point and the second 
time point based on the generated gait, in addition to the effects mentioned above, 
holding of the bending angle of the toe and releasing thereof can be made at appropriate 
time points. 

20 [0036] Further, since the legged mobile robot control system recited in claim 12 is 
configured to further include a bending angle detecting means for detecting the bending 
angle of the toe, and a gait generating means for generating a gait of the robot, and the 
bending angle controlling means determines the first time point based on the detected 
bending single and determines the second time point based on the generated gait, in 

25 addition to the effects mentioned above, holding of the bending angle of the toe and 
releasing thereof can be made at more appropriate time points. 

[0037] Further, the legged mobile robot control system recited in claim 13 is 
configured such that the bending angle controlling means holds the bending angle of the 
toe at a third time point during liftoff of the leg from the floor, which is later than the 
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second time point, and releasing the held bending angle of the toe at a fourth time point, 
after the leg has landed on the floor, which is earlier than the first time point at a next 
time, in addition to the effects mentioned above, sufficient contact area can be secured 
at the time of leg landing. 
5 [0038] Further, since the legged mobile robot control system recited in claim 14 is 
configured to further include a gait generating means for generating a gait of the robot, 
and the bending angle controlling means determines the first to fourth time points based 
on the generated gait, in addition to the effects mentioned above, holding of the bending 
angle of the toe and releasing thereof can be made at appropriate time points. 

10 [0039] Further, since the legged mobile robot control system recited in claim 15 is 
configured to further include a bending single detecting means for detecting the bending 
angle of the toe, and a gait generating means for generating a gait of the robot and the 
bending angle controlling means determines the first and third time points based on the 
detected bending angle, and determines the second and fourth time points based on the 

15 generated gait, in addition to the effects mentioned above, holding of the bending angle 
of the toe and releasing thereof can be made at more appropriate time points. 
[0040] Further, since the legged mobile robot control system recited in claim 16 is 
configured to further include a bending angle change suppressor that suppresses change 
of the bending angle of the toe; and the bending angle controlling means releases the 

20 held bending angle of the toe at the second time point to gradually restore the toe to the 
initial position by operating the bending angle change suppressor to reduce the bending 
angle progressively, in addition to the effects mentioned above, occurrence of 
overshooting and vibration can be prevented when the toe is restored to the initial 
position. 

25 [0041] Further, since the legged mobile robot control system recited in claim 17 is 
configured to further include a bending angle change suppressor that suppresses change 
of the bending angle of the toe, and the bending angle controlling means operates the 
bending angle change suppressor from the fourth time point to the first time point at the 
next time to control a floor reaction force acting to the robot through the foot, in 
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addition to the effects mentioned above, stability during tiptoe standing can be 
enhanced. 

[0042] Further, since the legged mobile robot control system recited in claim 18 is 
configured to further include a bending angle change suppressor that suppresses change 
5 of the bending angle of the toe in accordance with a predetermined resistance 
characteristic set with respect to angular velocity of the bending angle; and the bending 
angle controlling means manipulates a position or posture of the foot from the fourth 
time point to the first time point at the next time to regulate the bending angular velocity 
of the toe, thereby varying magnitude of resistance produced by the bending angle 
10 change suppressor to control a floor reaction force acting to the robot through the foot, 
in addition to the effects mentioned above, stability during tiptoe standing can be 
enhanced. 

[0043] Further, the legged mobile robot control system recited in claim 19 is 
configured to further include a bending angle change suppressor that suppresses change 

1 5 of the bending angle of the toe; a bending angle detecting means for detecting the 
bending angle of the toe, and a floor shape estimating means for estimating shape of the 
floor on which the foot is based on at least the detected bending angle, and the bending 
angle controlling means operates the bending angle change suppressor from the fourth 
time point to the first time point at the next time based on at least the estimated shape of 

20 the floor to control a floor reaction force acting to the robot through the foot, in addition 
to the effects mentioned above, stability during tiptoe standing can be enhanced. 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0044] FIG. 1 is a schematic drawing showing a legged mobile robot according to 
a first embodiment of the invention; 

FIG 2 is an enlarged sectional view of one foot of the legged mobile robot 
shown in FIG 1 ; 

FIG. 3 is an enlarged sectional view similarly showing the one foot of the 
legged mobile robot; 
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FIG 4 is an enlarged sectional view similarly showing the one foot of the 
legged mobile robot; 

FIG. 5 is an enlarged sectional view similarly showing the one foot of the 
legged mobile robot; 

^ FIG 6 is a block diagram showing the details of a control unit shown in FIG 

1 of the legged mobile robot; 

FIG 7 is a block diagram functionally showing the configuration and 
operation of a legged mobile robot control system shown in FIG 1 ; 

FIG 8 is a flowchart showing the operation of the legged mobile robot 
10 control system shown in FIG 1 ; 

FIG 9 is a block diagram indicating the calculation processing of a 
composite-compliance operation determiner shown in FIG 7; 

FIG 10 is a block diagram indicating the calculation processing of a 
compensating total floor reaction force's moment distributor shown in FIG 9; 
15 FIG 11 is a block diagram showing the calculation processing of a feet 

compensating angle determiner shown in FIG 9; 

FIG 12 is a block diagram showing the calculation processing of a foot 
compensating angle determiner shown in FIG 9; 

FIG 13 is a block diagram showing the processing of throttling control of a 
20 damper shown in FIG 2; 

FIG 14 is a time chart showing the transition of, inter alia, control mode of 
the damper shown in FIG 2; 

FIG 15 is a time chart similarly showing the transition of, inter alia, 
control mode of the damper; 
25 FIG 16 is an enlarged sectional view showing a foot of a legged mobile 

robot according to a second embodiment of the invention; 

FIG 17 is an enlarged sectional view similarly showing the foot of the 
legged mobile robot according to the second embodiment; 

FIG 18 is a schematic view showing a foot of a legged mobile robot 
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according to a third embodiment of the invention; 

FIG 19 is a schematic view similarly showing the foot of the legged 
mobile robot according to the third embodiment; 

FIG 20 is a block diagram showing the processing for hydraulic control of 
5 a friction brake shown in FIG 1 8; 

FIG 21 is a time chart showing the transition of, inter alia, control mode of 
the friction brake shown in FIG 18; 

FIG 22 is a schematic view showing a foot of a legged mobile robot 
according to a fourth embodiment of the invention; 
10 FIG 23 is a schematic view similarly showing the foot of the legged 

mobile robot according to the fourth embodiment; 

FIG 24 is a block diagram showing the processing for hydraulic control of 
a friction brake shown in FIG 22; 

FIG 25 is a time chart showing the transition of, inter alia, control mode of 
15 the friction brake shown in FIG 22; 

FIG 26 is an enlarged sectional view showing a foot of a legged mobile 
robot according to a fifth embodiment of the invention; 

FIG 27 is an enlarged sectional view similarly showing the foot of the 
legged mobile robot according to the fifth embodiment; 
20 FIG 28 is an enlarged sectional view similarly showing the foot of the 

legged mobile robot according to the fifth embodiment; 

FIG 29 is an enlarged sectional view similarly showing the foot of the 
legged mobile robot according to the fifth embodiment; 

FIG 30 is a time chart showing the transition of, inter alia, control mode of 
25 a legged mobile robot according to a sixth embodiment of the invention; 

FIG 31 is a block diagram showing the calculation processing of a foot 
compensating angle determiner of a legged mobile robot control system according to the 
sixth embodiment; 

FIG 32 is a block diagram showing the processing for hydraulic control of a 
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friction brake according to the sixth embodiment; 

FIG 33 is a time chart showing the transition of, inter alia, control mode of 
a legged mobile robot according to a seventh embodiment of the invention; 

FIG. 34 is a block diagram showing the processing of throttling control of a 
damper according to the seventh embodiment; 

FIG 35 is a time chart showing the transition of, inter alia, control mode of 
a legged mobile robot according to an eighth embodiment; 

FIG 36 is a block diagram shov^dng the calculation processing of a foot 
compensating angle determiner of a legged mobile robot control system according to the 
eighth embodiment; and 

FIG 37 is a block diagram showing the calculation processing of a foot 
compensating angle determiner of a legged mobile robot control system according to a 
ninth embodiment. 

15 BEST MODES FOR CARRYING OUT THE INVENTION 

[0045] The best modes for implementing the legged mobile robot and control 
system thereof according to this invention will be explained with reference to the 
attached drav^ngs in the following. 

20 First embodiment 

[0046] FIG 1 is a schematic drawing showing a legged mobile robot according to 

this embodiment. 

[0047] As illustrated, a legged mobile robot 1 (hereineifter called "robot") is a biped 
walking robot equipped with left and right legs (leg links) 2R, 2L (where R means right 
25 side and L means left side as viewed in the direction of forward movement; hereinafter the 
same) The right and left legs 2R(L) are respectively provided with six rotational shafts 
(degrees of freedom). The six rotational shafts comprise, starting from the top, rotational 
shafts lOR, lOL of hips (crotch) for leg swiveling (about Z-axes), rotational shafts 12R, 
12L about hip roll axes (about X axes), rotational shafts 14R, 14L about hip pitch axes 
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(about Y axes), rotational shafts 16R, 16L about knee pitch axes, rotational shafts 18R, 18L 
about ankle pitch axes, and rotational shafts 20R, 20L about ankle roll axes. 
[0048] Feet 22R, 22L are attached to the lower ends the legs 2R(L). Further, a body 
24 is attached to the upper ends of the legs 2R(L). A control unit 26, comprising a 
5 microcomputer, and so forth are housed in the body 24. hi the foregoing, the hip joints (or 
waist joints) comprise the rotational shafts 10R(L), 12R(L), 14R(L), the knee joints 
comprise the rotational shafts 16R(L), and the ankle joints comprise rotational shafts 
18R(L), 20R(L). Further, the hip joints and knee joints are connected by thigh links 28R, 
28L and the knee joints and ankle joints by shank links 30R, SOL. 

10 [0049] Thus the legs 2R(L) of the robot 1 are given 6x2=12 axes of rotation. And 

the legs as a whole can be imparted with desired movements by driving the rotational 
shafts to appropriate angles with electric motors (not shown), so the robot 1 can be made to 
walk as desired. Although arms and a head are provided on the body 24, illustration and 
explanation thereof are omitted because they are not directly related to the characteristics 

15 of the invention. 

[0050] Conventional six-axis force sensors 34R, 34L are attached below the ankle 
joints to measure force components Fx, Fy and Fz of three directions and moment 
components Mx, My and Mz of three directions, and detect, inter alia, whether or not the 
feet 22R(L) are in contact with the ground and the floor reaction force (landing load) 
20 acting on the robot 1 through the feet 22R(L), In addition, an inclination sensor 36 is 
installed on the body 24 and detects inclination relative to the Z axis (vertical direction 
(gravitational direction)) and the angular velocity thereof. Each of the electric motors for 
driving the rotationeil shafts has a rotary encoder installed adjacent thereto for detecting its 
amount of rotation. 

25 [0051] Further, spring mechanism units 38R, 38L are installed between the ground 
contact ends of the feet 22R(L) and the six-axis force sensors 34R(L), and soles 40R, 40L 
that are elastic bodies (specifically, bodies made of rubber) are attached to the soles of the 
feet to constitute compliance mechanisms 42R, 42L. 

[0052] FIGs 2 to 5 are enlarged sectional views of one foot 22. Since the left and 
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right feet 22R(L) are laterally symmetrical, affixation of R, L will be omitted in the 
explanation of FIG 2 and later figures. 

[0053] As shown in FIG 2, the sole 40 is composed of two vertically stacked and 

disposed rubber members (sole in contact with floor designated by symbol 40a; sole 
5 disposed thereabove designated by symbol 40b), and a foot plate 46 is disposed thereabove. 
The foot plate 46 is formed of an elastically deformable metal material. That is, the sole of 
the foot 22 is constituted to be elastically deformable. 

[0054] The aforesaid spring mechanism unit 38 is installed above the foot plate 46. 
The spring mechanism unit 38 comprises a spring mechanism unit &ame 381 formed of a 

10 high-rigidity metal material, multiple rubber bushes (elastic bodies) 382 accommodated 
within a space defined by the spring mechanism unit frame 381, and a spring mechanism 
unit plate 383 attached to the upper surfaces of the rubber bushes 382. 
[0055] Like the spring mechanism unit frame 381, the spring mechanism unit plate 

383 is formed of a high-rigidity metal material. Further, the six-axis force sensor 34 is 

1 5 attached to the top of the spring mechanism unit plate 383 and the shank link 30 of the leg 
2 is attached to the top of the six-axis force sensor 34 through the ankle joint 1 8, 20. 
[0056] When the robot 1 receives floor reaction force, the spring mechanism unit 38 
and the soles 40a, 40b in the compliance mechanism 42 flex to change the position/posture 
of the foot 22. This mechanism is not only for cushioning impact at floor contact but is also 

20 important for enhancing control performance. Note that explanation of the details thereof is 
omitted here because they are set out in the applicant's earlier proposed Japanese 
Laid-open Patent Application No. Hei 5-305584. 

[0057] Further, the foot 22 is provided with a damper 50. The damper 50 comprises 
a cylinder 50a in which a fluid (hydraulic fluid, for example) is sealed, a piston 50b 
25 disposed to be slidable inside the cylinder 50a, a communication passage 50c 
communicating spaces in the cylinder 50a that face each other across the piston 50b, an 
orifice 50d formed midway of the conununication passage 50c, an electromagnetic 
solenoid 50e for regulating the opening area of the orifice 50d to one or the other of zero 
and a predetermined value (other than zero) (i.e., to close or open the orifice 50d), and a 
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piston rod 50f connected to the piston 50b. That is, the damper 50 utilizes the flow 
resistance of the fluid passing through the orifice 50d. Note that FIG 2 shows the state of 
the opening area of the orifice 50d regulated to the predetermined value. Further, the 
electromagnetic solenoid 50e regulates the opening area of the orifice 50d to the 
5 predetermined value when energized and regulates it to zero when de-energized. 

[0058] One end (cylinder bottom) of the damper 50 is connected to the fore end 
(fore end viewed in the direction of forward movement) of the spring mechanism vinit 
fi-ame 381 to be rotatable about a pitch axis. On the other hand, the other end (rod head) of 
the damper 50 is connected to the fore end of the foot plate 46 to be rotatable about a pitch 
10 axis. 

[0059] Here, as shown in FIG 3, when the heel of the foot 22 lifts off the floor with 
the opening area of the orifice 50d regulated to the predetermined value (i.e., with the 
piston 50b movable inside the cylinder 50a and the damper 50 capable of extension/ 
contraction), the region of the elastically deformable foot 22 forward of the region where 
15 the spring mechanism unit firame 381 made of high-rigidity material is attached flexes and 
bends. Hereinafter, this region in the foot 22 that bends is called the "toe" and is designated 
by symbol 22t. Further, the remaining region other than the toe 22t in the foot 22 is called 
the "foot main body" and designated by symbol 22m. 

[0060] Thus the foot 22 comprises the foot main body 22m connected to the leg 2 
20 through the spring mechanism unit 38 and so forth, and the toe 22t provided at the fore end 
thereof. Further, the toe 22t is made of an elastic body continuous with the foot main body 
22m and is bendable with respect to the foot main body 22m. 

[0061] On the other hand, as shown in FIG 4, when the opening area of the orifice 

50d is regulated to zero with the toe 22t bent, movement of the piston 50b 
25 (extension/contraction of the damper 50) becomes impossible and the bending angle of the 
toe 22t at that time (designated by 0t in FIG 4) is held or maintained. Further, when the 
robot 1 is not in the state of tiptoe standing, if the opening area of the orifice 50d is 
returned to the predetermined value to make the piston 50b movable, the restoring force of 
the sole 40a, 40b and foot plate 46 restores the toe 22t to its initial position (position of 
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zero bending angle). In addition, as shown in FIG 5, when the toe 22t is not bent, the toe 
22t can be held or maintained at the initial position by regulating the opening area of the 
orifice 50d to zero. 

[0062] That is, one end of the damper 50 is connected to the foot main body 22m 

5 side, the other end is connected to the toe 22t side, and extension/contraction thereof is 
disabled by adjusting the aperture thereof. Specifically, the electromagnetic solenoid 50e 
provided in the damper 50 is operated to regulate the opening area of the orifice 50d to 
zero to hold the bending angle of the toe 22t at the angle at that time. In other words, the 
damper 50 is provided between the foot main body 22m and toe 22t and configured to 

10 make the opening area of the orifice 50d adjustable between zero and the predetermined 
value, whereby the bending angle of the toe 22t can be held or maintained anywhere in the 
movable range of the toe 22t. In other words, it is made possible to hold or maintain the 
bending angle of the toe 22t at an arbitrary angle in the movable range of the toe 22t (in 
still other words, anywhere in the continuum of angles within the movable range). 

15 [0063] Further, the damper 50 utilizes the flow resistance of the fluid passing 
through the aforesaid orifice 50d. Therefore, increase/decrease of the bending angle is 
resisted to suppress change thereof even when the bending angle of the toe 22t is not held. 
[0064] That is, the damper 50 fimctions as a mechanism capable of holding the 
bending angle of the toe 22t in the movable range thereof (hereinafter called the "bending 

20 angle holder") and simultaneously also functions as a mechanism for suppressing the 
bending angle change (hereinafter called the "bending angle change suppressor"). 
[0065] Thus the foot 22 comprises the foot main body 22m connected to the leg 2 

and the toe 22t provided on the fore end of the foot main body 22m to be bendable with 
respect to the foot main body 22m and is equipped with the damper 50 as the bending 

25 angle holder capable of holding the bending angle of the toe 22t in the movable range 
thereof and as the bending angle change suppressor for suppressing bending angle change. 
[0066] FIG 6 is a block diagram showing the details of a control unit 26. In the 
control unit 26, the outputs of the six-axis force sensors 34R(L), inclination sensor 36 and 
the like are converted to digital values by an A/D converter 60 and then inputted to a RAM 
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64 through a bus 62. Further, the outputs of the encoders installed adjacent to the electric 
motors are inputted to the RAM 64 through a counter 66. 

[0067] First and second calculators 70, 72 constituted as CPUs are provided inside 

the control unit 26 and, as discussed later, the first calculator 70 calculates displacement 
5 commands for the rotational shafts and toes based on a gait stored in a ROM 74 and sends 
them to the RAM 64. Further, the second calculator 72 reads the commands and detected 
measured values firom the RAM 64, calculates control values required to regulate driving 
of the rotational shafts and bending angle of the toes, and outputs them through a D/A 
converter 76 and a servo amplifier to the electric motors that drive the joints. In addition, a 
10 joystick 80 is connected to the control unit 26 by wire or wdrelessly to establish a 
configuration that enables requests regarding gait, such as straight forward or turning 
movement, to be inputted to the robot 1 from the exterior. 

[0068] Next, an explanation will be made regarding the control system of the legged 

mobile robot according to this embodiment. The control system according to this 

1 5 embodiment is, in overview, what is obtained by adding control related to the aforesaid 
bendable toes to the technique set out in the applicant's earlier proposed Japanese 
Laid-open Patent Application No. Hei 10-277969 (technique of manipulating foot postural 
inclination for appropriately controlling floor reaction force acting on robot; hereinafter 
called "composite-compliance control"). 

20 [0069] Note that the meanings of the terms used in the foUowdng explanation are in 
accordance with the definitions in said Japanese Laid-open Patent Application No. Hei 
10-277969 (and the references cited therein). In the ensuing description, explanation 
regarding structural features other than characteristic features of this application are limited 
to a general summary of their operations, and they are concretely implemented in 

25 accordance with the conditions, equations and the like set out in detail in the previously 
proposed aforesaid references. 

[0070] FIG 7 is a block diagram fimctionally showing the configuration and 

operation of the legged mobile robot control system according to this embodiment. 

[0071] As shown in FIG 7, the control system is equipped with a gait generator 100 
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and the gait generator 100 generates and ou^uts a desired gait. The desired gait comprises 
a desired motion pattem and a desired floor reaction force pattem, more specifically, a 
desired body position/posture trajectory, a desired foot position/posture trajectory, a desired 
total floor reaction force central point (desired ZMP) trajectory, and a desired total floor 
5 reaction force trajectory (or pattem). 

[0072] The desired total floor reaction force outputted by the gait generator 100 is 
the total floor reaction force dynamically equilibrate with the desired motion pattem. 
Therefore, the desired total floor reaction force central point is made equal to the desired 
ZMP. 

10 [0073] A desired floor reaction force distributor 102 inputs the aforesaid desired total 
floor reaction force central point (desired ZMP) and desired foot position/posture as its 
main input and determines and outputs a desired foot floor reaction force central point. 
Actually, the gait parameters from the gait generator 100 (e.g., two-leg support stage time 
period, desired free leg landing position and the like), the gait stage/time period (e.g., the 

15 fact that the current time is 0.1 [sec] after the beginning of the two-leg support period and 
the like), and other such information are fetched as necessary. 

[0074] Further, the desired floor reaction force distributor 102 also determines and 
outputs desired foot floor reaction force. The desired foot floor reaction force is necessary 
for flex compensation of the compliance mechanism 42. 
20 [0075] A posture stabilization controller 104 estimates the state of the robot 1 based 
on the sensor information and calculates a compensating total floor reaction force's 
moment. 

[0076] Further, an actual foot floor reaction force detector 108 detects the actual foot 
floor reaction force (the resultant of which is the actual total reaction force) in accordance 
25 with the ou^uts of the six-axis force sensors 34. In addition, the relative position/posture 
of each foot 22R(L) with respect to a coordinate system fixed on the body 24 is calculated 
based on the actual displacements detected by the joint encoders (and/or displacement 
commands), the detection values of the six-axis force sensors 34 are 
coordinate-transformed thereby and the actual foot floor reaction force expressed in the 
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coordinate system fixed on the body are calculated, whereafter they are converted to the 
supporting leg coordinate system. 

[0077] Upon being inputted with the body position/posture and foot position/posture, 
a robot geometric model (inverse kinematic solution) 110 calculates joint displacements 
5 that satisfy them. Here, the inverse kinematic solution equation is directly determined and 
the joint displacements are obtained simply by substituting the body position/posture and 
foot position/posture into the equation. That is, the robot geometric model 110 is inputted 
with the desired body position/posture and the corrected desired foot position/posture 
trajectory (corrected desired foot position/posture trajectory with deformation 
10 compensation) corrected in a composite-compliance operation determiner 114 discussed 
below, and displacement commands (values) for the 12 rotational shafts (lOR(L) etc.) are 
calculated therefrom. 

[0078] A displacement controller 112 (same as the aforesaid second calculator 72) 

controls the displacement of the 12 rotational shafts of the robot 1 to follow as desired 
15 values the joint displacement commands (v£ilues) calculated by the robot geometric model 
(inverse kinematic solution) 110. 

[0079] The composite-compliance operation determiner 114 corrects the desired foot 
position/posture trajectory so as to make the resultant of the desired total floor reaction 
force and the compensating total floor reaction force agree with the actual total floor 
20 reaction force. Note that the aforesaid 'total floor reaction force" and "foot floor reaction 
force" are concretely expressed by the point of action and the force and moment of force 
acting thereat, and in the actual computation the force component and moment component 
are used as set out below. 

[0080] Based on the foregoing, the operation of the system will be explained with 
25 reference to the FIG 8 flowchart (structured flowchart). Note that on the left side of the 
drawing are shown the corresponding processing operations performed by the constituent 
elements of the FIG 7 block diagram. 

[0081] First, in SIO, the system is initialized and the program proceeds through S12 
to SI 4, wherein it waits for timer interrupt. A timer interrupt is done every 50 [msec]. That 
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is, the control cycle of this system is 50 [msec]. 

[0082] The program next proceeds to SI 6, in which it is determined whether the gait 

is at a point of switching, specifically whether it is at a point of switching the supporting 
leg, and when the result is NO, proceeds to S22, and when YES, proceeds to SI 8, in which 
5 a timer t is initialized, and to S20, in which desired gait parameters are set. As explained 
above, the gait parameters comprise motion parameters and floor reaction force parameters 
(ZMP trajectory parameters). 

[0083] The program then proceeds to S22, in which the instantaneous values of the 
desired gait are determined. Here, "instantaneous values" means the values at every control 
1 0 cycle, and the desired gait instantaneous values comprise the desired body position/posture, 
desired foot position/posture and desired ZMP position. Note "posture" here means 
"orientation" in X, Y, Z space. 

[0084] The program then proceeds to S24, in which the desired foot floor reaction 

force central point is determined, and further proceeds to S26, in which the desired foot 
1 5 floor reaction force is determined. 

[0085] The program then proceeds to S28, in which the inclination of the body 24 
and other conditions of the robot 1 are detected from the outputs of the aforessiid 
inclination sensor 36 and the like. 

[0086] The program then proceeds to S30, in which compensating total floor 

20 reaction force moments (about the desired total floor reaction force central point (desired 
ZMP)) Mdmdx, Mdmdy for posture stabilization through the states of the robot 1 and 
some similar factors are determined. 

[0087] The program then proceeds to S32, in which the actual foot floor reaction 

force is detected. As explained above, this is detected from the output of the six-axis force 
25 sensor 34. 

[0088] The program then proceeds to S34, in which a feet compensating angle Gdbv 
and a foot compensating angle 9nx(y) are determined. These are tasks conducted by the 
composite-compliance operation determiner 114. 

[0089] Note that in this specification "n" indicates a leg serial number (n : 1 or 2), 
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where the leg remaining in contact with the floor for a certain gait period is represented as 
"1" and the other leg as "2." 

[0090] FIG 9 is a block diagram indicating the processing of the 

composite-compliance operation determiner 114; the processing will be explained with 
5 reference to this diagram. 

[0091] A compensating total floor reaction force's moment distributor 114a divides 
the compensating total floor reaction force's moment Mdmd into a feet compensating 
moment Mdmddb and foot compensating moments Mdmdlx, Mdmdly, Mdmd2x, 
Mdmd2y. The feet compensating moment Mdmddb (whose component about the V 

10 direction is denoted Mdmddbv) is the desired value of the moment produced by a force 
component of the foot floor reaction force about the desired total floor reaction force 
central point (desired ZMP) to be obtained by manipulating the feet compensating angle 
(foot vertical amount) Odbv. Note that "V" in the foregoing is the normal vector to a plane 
perpendicular to horizontal including the desired foot floor reaction force central point and 

1 5 has a magnitude of 1 . 

[0092] Specifically, the distribution is conducted in accordance with the block 

diagram shown in FIG 10. In FIG 10, Wdbx, Wdby, Wlx, Wly, W2x, W2y and Wdbint 
are weighting parameters for distribution. Vx is the value of the X-component of vector V 
and Vy is the value of the Y-component of vector V. Wdbint among them is for canceling 

20 the total floor reaction force's moment generated by manipulation of the feet compensating 
angle, by manipulating the foot compensating angle. 

[0093] Retuming to the explanation of FIG 9, next, taking the actual foot floor 
reaction force and distributed compensating total floor reaction force's moment and the 
like into account, the aforesaid compensating angles Odbv and Onx(y) are determined in a 
25 feet compensating angle determiner 114b and nth foot X(Y) compensating angle 
determiners 1 1 4c, 1 1 4d, 11 4e, 11 4f. 

[0094] FIG 1 1 is a block diagram of the processing of the feet compensating angle 

determiner 1 14b and the feet compensating angle Odbv is calculated as illustrated. 

[0095] Explaining with reference to FIG 11, the moment MflfZact generated about 
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a desired total floor reaction force central point P is determined based on the force 
component Flact of the actual floor reaction force acting at a desired first foot floor 
reaction force center point Ql and the force component F2act of the actual floor reaction 
force acting at a desired second foot floor reaction force center point Q2. 
5 [0096] Next, the V vector-direction component MflfZactv of Mflf2act is extracted. 

Next, MflfZactv is passed through a low-pass filter 1 14i to obtain MflfZactvfilt. 
[0097] Next, the feet compensating moment's vector V-direction component 
Mdmddbv is passed through a compensating filter 114j to subtract it fi-om MflfZactvfilt 
and obtain a deviational moment V-direction component MdifiV. 

10 [0098] Note that the compensating filter 114j is for enhancing the fi-equency 
response characteristic of the transfer function fi-om the feet compensating moment's 
V-direction component Mdmddbv to the actual total floor reaction force's moment. 
[0099] Next, a feet deformation compensating angle Offdbv for canceling the effect 

of the deformation of the compliance mechanism 42 on the feet compensating moment's 

15 vector V-direction component Mdmddbv is determined. This is so-called feed-forward 
compensation. 

[0100] Finally, the feet deformation compensating angle Offdbv is added to the 
product of the deviational moment V-direction component MdifiV and the control gain 
Kdb to obtain the feet compensating angle Gdbv. 

20 [0101] Next, the nth foot compensating angle determiners will be explained. FIG 12 
is a block diagram showing the processing of the 1st foot X-compensating angle 
determiner 114c thereamong. The 1st foot X-compensating angle determiner 114c 
calculates a 1st foot X-compensating angle Olx in the illustrated manner. Although 
explanation will be omitted, a 1st foot Y-compensating angle Oly, 2nd foot X- 

25 compensating angle 92x, and 2nd foot Y-compensating angle 92y are similarly determined. 
Only the algorithm for determining the 1st foot X-compensating angle 01x will be 
explained here. 

[0102] The actual 1st foot floor reaction force* moment's X-component Mlactx is 
passed through a low-pass filter 114k to obtain Mlactfiltx. The 1st foot compensating 
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moment's X-component Mdmdlx is passed through a compensating filter 114m to subtract 
it fi-om Mlactfiltx and obtain the deviational moment MdiflFlx. Similarly to in the feet 
compensating angle determination, the compensating filter 114m is for enhancing the 
frequency response characteristic of the transfer fimction from Mdmdlx to the actual total 
5 floor reaction force. 

[0103] Next, similarly to in the feet compensating angle determmation, a 1st foot 
X-component deformation compensating angle OjBFlx for canceling the efiect of the 
deformation of the compliance mechanism 42 on the 1st foot compensating moment's 
X-component is determined. This is so-called feed-forward compensation. 
10 [0104] Finally, the 1st foot X-component deformation compensating angle GflFlx is 
added to the product of the deviational moment MdiflFlx and the control gain Klx to obtain 
the 1st foot X-compensating angle 91x. 

[0105] Retuming to the explanation of FIG. 9, next, a corrected desired foot 

position/posture calculator 114g corrects the desired foot position/posture based on the 

15 feet compensating angle Gdbv, 1st foot X-compensating angle Olx, 1st foot Y- 
compensating angle 91y, 2nd foot X-compensating angle 92x and 2nd foot Y-compensating 
angle 92y, thereby obtaining a corrected desired foot position/posture. 
[0106] A deformation amount calculator 1 14h determines the amount of deformation 
of the compliance mechanism 42 that would be produced by the desired foot floor reaction 

20 force. 

[0107] A corrected desired foot position/posture with deformation compensation 

calculator 114n fiirther corrects the corrected desired foot position/posture so as to cancel 
the calculated deformation amoxmt, thereby obtaining a corrected desired foot 
position/posture with deformation compensation. 
25 [0108] Resuming the explanation of the flowchart of FIG 8 against the backdrop of 
the foregoing explanation, the aforesaid compensating angles are detennined in S34 as set 
out in the foregoing. 

[0109] The program then proceeds to S3 6, in which the deformation compensating 
amount is calculated based on the desired foot floor reaction force, and to S38, in which 



-23 - 



the desired foot position/posture is corrected in accordance with the compensating angles 
Gdbv, 9nx(y) and the resuU is further corrected in accordance with the deformation 
compensating amount to obtain the corrected desired foot position/posture with 
deformation compensation. 
5 [0110] The program then proceeds to S40, in which a joint displacement command 

(value) is calculated from the body position/posture and the corrected desired foot 
position/posture with deformation compensation, proceeds to S42, in which servo control 
is performed to make the actual joint displacement follow the calculated joint displacement 
command (value), proceeds to S44, in which the time is incremented by At, and returns to 

10 S 1 4 to repeat the foregoing processing. 

[0111] Among the operations of the legged mobile robot control system according 

to this embodiment, the operation for holding the bending angle of the toe 22t and that 
for releasing the same will be explained next with reference to FIGs. 13 to 15. 
[0112] FIG 13 is a block diagram showing a throttling control processing 

1 5 conducted by the damper 50. 

[01 13] As illustrated, the control system is equipped with a select switch 118. Two 
signals are inputted to the select switch 118, namely, Rd_close (orifice 50d close 
command, i.e., bending angle holding command) and Rd_open (orifice 50d open 
command, i.e., held bending angle releasing command), which correspond to two types 

20 of control modes of the damper 50, i.e., "CLOSE" and "OPEN." And one or the other 
thereof is selected at predetermined timing set out later and outputted to the damper 50 
as a damper throttling command R_d (specifically, a command value of energization 
current to the electromagnetic solenoid 50e). 

[0114] FIG 14 is a time chart showing the transition of, inter alia, the control 
25 mode of the damper 50 when the robot 1 moves over flat terrain. Note that in FIG 14 
the "desired foot posture angle" is zero when the foot 22 is horizontal, and exhibits a 
positive value when the fore end of the foot 22 is positioned below its hind end and a 
negative value when the fore end of the foot 22 is positioned above its hind end. 
Therefore, when, for instance, the leg 2 is landed and the desired foot posture angle has 
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a positive value, this indicates that the robot 1 is standing on tiptoe. Further, the 
"vertical component of desired foot floor reaction force's translational force" means the 
force component in the Z-axis direction 2imong the translational components of the floor 
reaction force that is desired. 
5 [0115] To explain the FIG 14 time chart, "CLOSE" is selected betv^^een the first 
time point tl, which is the liftoflF time of the leg 2, and the second time point t2 after 
liftofiF, and "OPEN" is selected between the second time point t2 and third time point t3 
before landing of the leg 2. Further, "CLOSE" is again selected between the third time 
point t3 and fourth time point t4 at which the leg 2 lands and tiptoe standing begins, and 
10 "OPEN" is selected between the fourth time point t4 and first time point tl of the next 
cycle. 

[0116] That is, the bending angle of the toe 22t is held at the first time point tl 

(the liftoflF time of the leg 2) and the held bending angle is released at the second time 
point t2 after the leg 2 has lifted off. Further, the bending angle of the toe 22t is again 
15 held at the third time point t3, which is later in time than the second time point t2 and 
prior to landing of the leg 2, and the holding of the bending angel is released at the 
fourth time point t4, after landing of the leg 2 and earlier in time than the first time point 
tl of the next cycle. 

[0117] This will be explained concretely in the following: Between the fourth 
20 time point t4 at which tiptoe standing begins and the first time point tl, which is the 
liftoflF time (i.e., during the tiptoe standing period), the held bending angle is released to 
make the toe 22t bendable, so that the toe 22t is bent in accordance with change in the 
foot posture angle, thereby securing the contact area necessary for toe-oflF. 
[0118] Next, the bending angle at the instant of liftoff is held xmtil the second time 
25 point t2 after liftoflF (specifically, until the toe 22t has thoroughly separated fi-om the 
floor). 

[0119] The toe 22t is then restored to its initial position by releasing the held 
bending angle at the second time point t2. At this time, the bending angle of the toe 22t 
decreases progressively and gradually resumes its initial position owing to the flow 
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resistance of the damper 50. 

[0120] Further, the bending angle of the toe 22t is held in the course of liftoff 
between the third time point t3, which is later in time than the second time point t2 
(more specifically, the time point after the toe 22t resumes the initiad position) and the 
5 fourth time point t4 at which tiptoe standing begins (in other words, until the foot 22 
completes flat groimd contact), so that the toe 22t is locked in its initial position to 
secure maximum contact area at the time of landing and the time of flat ground contact. 
[0121] Note that the first time point tl to the fourth time point t4 are all 
determined based on the desired gait of the robot 1 outputted by the gait generator 100. 
10 [0122] FIG. 15 is a time chart showing the transition of, inter alia, control mode of 
the damper 50 when the robot 1 climbs stairs. 

[0123] During stair climbing, a prolonged tiptoe standing period generally occurs 

at the late stage of the supporting leg. When the period during which the toe 22t is 
bendable becomes long, the control performance is likely to be degraded because the 
15 aforesaid compliance control is a technique for manipulating the postural inclination of 
the foot so as to suitably control the floor reaction force acting on the robot. Therefore, 
as shown in FIG 15, during stair climbing the first time point tl at which the bending 
angle of the toe 22t is held, is defined to be a time point that is earlier in time than the 
liftoff time of the leg 2. 

20 [0124] Specifically, as illustrated, the desired foot posture angle is made constant 

during the latter half of the tiptoe standing period and the bending angle of the toe 22t is 
held. As a result, the aforesaid compliance control operates effectively during the latter 
half of the tiptoe standing period, whereby the posture can be stabilized. 
[0125] Thus the robot 1 according to the first embodiment is equipped with the 

25 damper 50 as a bending angle holder capable of holding the bending angle of the toe 22t 
in the bendable or movable range thereof and the bending angle of the toe 22t is held from 
the first time point tl (the liftoff time of the leg 2, or the still earlier-in-time thereof) to the 
second time point t2 after the leg 2 has lifted off, so that the bending angle at the time of 
Hftoflf can continue to be held after liftoff, whereby the robot 1 can be prevented from 
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becoming unstable owing to the toe 22t contacting the floor immediately after liftoflF. In 
addition, the first time point tl at which holding of the bending angle begins is defined to 
be a time point earlier than the liftofiF time, so that stability during tiptoe standing can be 
enhanced owing to the fact that the bending angle of the toe 22t can be held (the toe 22t 
5 can be locked) also during tiptoe standing. 

[0126] Further, the bending angle of the toe 22t is held to lock the toe 22t in its 

initial position from the third time point t3 during liftoff of the leg 2, which is later than 
the second time point t2, to the fourth time point t4 at which tiptoe standing begins, so 
that maximum contact area can be secured at the time of landing and the time of flat 
1 0 ground contact. 

[0127] Further, the damper 50 also functions as a bending angle change 
suppressor that suppresses change of the bending angle of the toe 22t, so that occurrence 
of overshooting and vibration can be prevented when the toe 22t restores to the initial 
position. 

15 [0128] Fvirther, the structure of the foot 22 can be made simple because the toe 22t is 
made continuous with the foot main body 22m and is made of an elastic material that 
bends with flexing. 

Second embodiment 
20 [0129] A legged mobile robot and control system thereof according to a second 
embodiment of this invention will be explained with reference to FIGs. 1 6 and 1 7 in the 
following. 

[0130] FIGs. 16 and 17 are enlarged sectional views showing a foot of the legged 
mobile robot according to the second embodiment. 
25 [0131] An explanation will be made with focus on the points of difference from 
the first embodiment in the following: As shown in FIGs. 16 and 17, in a foot 222 
according to the second embodiment a foot main body 222m and a toe 222t are divided 
and the two are connected through a rotational shaft 222a capable of rotating about a 
pitch axis. That is, the toe 222t is made bendable with respect to the foot main body 
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222m by rotating the rotational shaft 222a. 

[0132] Further, unlike in the first embodiment, it is not necessary to impart 

elasticity to the foot because the foot main body 222m and toe 222t are connected 
through the rotational shaft 222a. So a foot plate 46m on the foot main body 222m side 
5 is formed integrally with the spring mechanism unit fi-ame 381 of high-rigidity metal 
material. Similarly, a foot plate 46t on the toe 222t side is also formed of high-rigidity 
metal material. 

[0133] On the other hand, in light of the fact that the foot is not provided with 
elasticity, a restoring spring 222b is provided for urging the toe 222t in the direction of 
10 restoring it to the initial position, thereby assisting restoration of the toe 222t to the 
initial position. To be specific, the restoring spring 222b is a compression coil spring 
inserted between a flange 222c provided on the rod head of the piston rod 50f and the 
cylinder 50a. 

[0134] Note that explanation of the remainder of the configuration is omitted 

15 because it is the same as that of the first embodiment. 

[0135] Thus in the second embodiment the toe 222t and foot main body 222m are 
divided and the two are connected through the rotational shaft 222a, so that effects like 
those of the first embodiment can be obtained. Further, the toe 222t can be bent by 
rotating the rotational shaft 222a and, therefore, the contact area during the tiptoe 

20 standing period can be maintained constant irrespective of how large or small the 
bending angle. Further, restoration of the toe 222t to the initial position can be 
performed rapidly because the restoring spring 222b is provided. 

Third embodiment 

25 [0136] A legged mobile robot and control system thereof according to a third 
embodiment of this invention will next be explained with reference to FIGs. 1 8 to 21 . 
[0137] FIGs. 18 and 19 are schematic views showing a foot of the legged mobile 
robot according to the third embodiment. 

[0138] An explanation will be made with focus on the points of difference fi-om 
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the first embodiment: A foot 223 according to the third embodiment is equipped with a 
friction brake 60 as a bending angle holder capable of holding the bending angle of a toe 
223t in the movable range thereof and with a damper 500 as a bending angle change 
suppressor for suppressing bending angle change. 
5 [0139] The friction brake 60 comprises a shaft 60a attached to the fore end of the toe 

223t to be rotatable about a pitch axis and a clamping mechanism 60b attached at a suitable 
position on the foot main body 223m to be rotatable about a pitch axis. The shaft 60a is 
movably inserted inside the clamping mechanism 60b. When the clamping mechanism 60b 
is supplied with hydraulic pressure from an unshown hydraulic pressure generating unit, a 
10 brake disposed to surround the shaft 60a presses onto the shaft 60a, thereby clamping the 
shaft 60a. As a result, movement of the shaft 60a is made impossible to hold the bending 
angle of the toe 223t. 

[0140] Like the damper 50 mentioned with regard to the first and second 

embodiments, the damper 500 also uses the flow resistance of a fluid but differs in the 

1 5 following point. That is, the foot 223 of the third embodiment is equipped with the friction 
brake 60 as the bending angle holder and so the damper 500 is not required to have such 
fimction. Therefore, the damper 500 is not equipped with the electromagnetic solenoid 
provided in the damper 50 for regulating the opening area of the orifice. 
[0141] Among the operations of the legged mobile robot control system according 

20 to the third embodiment, the operation for holding the bending angle of the toe 223t and 
that for releasing the same will be explained next. 

[0142] FIG 20 is a block diagram showing processing for hydraulic control of the 
fiiction brake 60. 

[0143] As illustrated, the control system according to the third embodiment is 
25 equipped with a select sv^dtch 120. Two signals are inputted to the select switch 120, 
namely, P_high (high-pressure conmiand, i.e., bending angle holding conrmiand) and 
P_zero (hydraulic pressure supply stop conmiand, i.e., held bending angle releasing 
command), which correspond to two types of control modes of the fiiction brake 60, 
namely, "LOCK" and "FREE." And one or the other thereof is selected at the aforesaid 
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predetermined timing to output a hydraulic command P_b to the hydraulic pressure 
generating unit. 

[0144] FIG 21 is a time chart showing the transition of, inter alia, the control 

mode of the friction brake 60 when the robot 1 moves over flat terrain. 
5 [0145] As shown in the FIG. 21 time chart, the timing of holding and releasing the 
bending angle of the toe according to the third embodiment is the same as that in the 
earlier embodiment (shown in FIG 14). Further, although omitted in the drawings, also 
when the robot 1 climbs stairs the holding of the bending angle of the toe and the 
releasing thereof can be performed at the same timing as that of the earlier embodiment 

10 (shown in FIG 15). 

[0146] Thus the third embodiment is equipped with the friction brake 60 as the 

bending angle holder capable of holding the bending angle of the toe 223t in the movable 
range thereof and with the damper 500 as the bending angle change suppressor for 
suppressing bending angle change, whereby effects like those of the foregoing 

1 5 embodiments can be obtained. 

[0147] Note that explanation of the remainder of the configuration is omitted 
because it is the same as that of the earlier embodiments. Further, the foregoing 
explanation is also applicable to the case where, in the foot 222 described in the second 
embodiment, the damper 50 is replaced with the fi-iction brake 60 and damper 500. 

20 

Fourth embodiment 

[0148] A legged mobile robot and control system thereof according to a fourth 
embodiment of this invention will next be explained with reference to FIGs. 22 to 25. 
[0149] FIGs. 22 and 23 are schematic views showing a foot of the legged mobile 
25 robot according to the fourth embodiment. 

[0150] As shown in FIGs. 22 and 23, a foot 224 according to the fourth 
embodiment is equipped with the friction brake 60 instead of the damper 50 provided 
on the foot 22 of the first embodiment. 

[0151] An explanation will be made regarding the points of difference from the 
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earlier embodiments: In the fourth embodiment, the frictional force of the aforesaid 
friction brake 60 is made adjustable, whereby the friction brake 60 is made to function 
as the bending angle change suppressor for suppressing the bending angle change of a 
toe 224t. 

5 [0152] That is, the movement of the shaft 60a is suppressed by determining or 
setting the hydraulic pressure to be supplied to the friction brake 60 to a value between 
the aforesaid P high and P_zero, thereby suppressing change of the bending angle of 
the toe 224t. 

[0153] Among the operations of the legged mobile robot control system according 
10 to the fourth embodiment, the operation for holding the bending angle of the toe 224t 
and that for releasing the same will be explained next. 

[0154] FIG. 24 is a block diagram showing processing for hydraulic control of the 
friction brake 60. 

[0155] As illustrated, the control system according to the fourth embodiment is 
15 equipped with a select switch 122. Three signals are inputted to the select switch 122, 
namely, P high (high-pressure command, i.e., bending angle holding command), P_low 
(low-pressure command, i.e., bending angle change suppressing command) and P__zero 
(hydraulic pressure supply stop command, i.e., held bending angle releasing command), 
which correspond to three types of friction brake 60 control modes, namely, "LOCK," 
20 "SEMI-FREE" and "FREE." And one among them is selected at the aforesaid 
predetermined timing to output a pressure command P_b to the hydraulic pressure 
generating unit. 

[0156] FIG. 25 is a time chart showing the transition of, inter alia, the control 

mode of the friction brake 60 according to the fourth embodiment. 
25 [0157] As shown in FIG 25, in the fourth embodiment, change of the bending 
angle of the toe 224t is suppressed between the second time point t2 and third time point 
t3 by selecting "SEMI-FREE" as the control mode of the friction brake 60. That is, the 
held bending angle of the toe 224t is released at the second time point t2 and the 
fnctional force of the friction brake 60 is simultaneously utilized to reduce the bending 
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angle progressively, thereby gradually restoring it to the initial position. As a result, 
occurrence of overshooting and vibration can be prevented when the toe 224t restores to 
the initial position. 

[0158] Note that FIG 25 is a time chart for when the robot 1 moves over flat terrain, 
5 and when it climbs stairs, it suffices to set the first time point tl to a time point before the 
liftoff time of the leg, as in the earlier embodiments. Further, explanation of the remainder 
of the configuration is omitted because it is the same as that of the earlier embodiments. 
[0159] Further, the foregoing explanation is also applicable to the case where, in 
the foot 222 described in the second embodiment, the damper 50 is replaced with the 
1 0 fiiction brake 60. 

Fifth embodiment 

[0160] A legged mobile robot and control system thereof according to a fifth 
embodiment of this invention will next be explained with reference to FIGs, 26 to 29. 
15 [0161] FIGs. 26 and 27 are enlarged sectional views showing a foot of the legged 
mobile robot according to the fifth embodiment. 

[0162] As shown in FIGs. 26 and 27, in the fifth embodiment, the damper 50 of 

the first embodiment, installed on the foot 22, is provided internally with a stroke sensor 
22s (linear encoder, potentiometer or the like) for detecting the displacement (stroke) of 
20 the piston rod 50f. Note that the detection value of the stroke sensor 22s is inputted to 
the RAM 64 of the aforesaid control unit 26. 

[0163] As illustrated, the stroke of the piston rod 50f varies wdth the bending 
angle of the toe 22t. That is, detecting the stroke of the piston rod 5 Of amounts to 
detecting the bending angle of the toe 22t. The detection value of the stroke sensor 22s 
25 will hereinafter be treated as the detected value of the bending angle of the toe 22t. 

[0164] The control system of the legged mobile robot according to the fifth 
embodiment will be explained next. 

[0165] In the fifth embodiment, the aforesaid first time point tl and third time 
point t3 are determined based on the detected value of the bending angle of the toe 22t. 
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[0166] Specifically, when the detected value of the bending angle reaches a 
predetermined value after the held bending angle of the toe 22t has been released at the 
fourth time point t4, that time point is determined as the first time point tl to hold the 
bending angle. Further, when the detected value of the bending angle reaches zero after 
5 the held bending angle of the toe 22t has been released at the second time point t2, that 
time point is determined as the third time point t3 to hold the bending angle again. 
[0167] Note that explanation of the remainder of the configuration is omitted 
because it is the same as that of the earlier embodiments. 

[0168] Thus, in the fifth embodiment, a sensor is provided for detecting the 
10 bending angle of the toe 22t, and the first and third time points tl , t3 at which holding of 
the bending angle is commenced are determined based on the detected value, whereby 
in addition to achieving the effects set forth regarding the earlier embodiments it is 
possible to perform the operations for holding the bending angle of the toe 22t at more 
suitable time points. 

15 [0169] Note that the foregoing explanation is also applicable to the case where, as 
shown in FIGs. 28 and 29, a rotation angle sensor 222s (rotary encoder, rotary 
potentiometer or the like) is provided on the foot 222 of the second embodiment for 
detecting the rotation angle of the rotational shaft 222a, thereby detecting the bending 
angle of the toe 222t. Further, it is also applicable in the case where the aforesaid sensor 

20 is provided on the foot explained regarding the third embodiment or fourth embodiment. 

Sixth embodiment 

[0170] A legged mobile robot £ind control system thereof according to a sixth 
embodiment of this invention will next be explained with reference to FIGs. 30 to 32. 
25 Note that the following explanation is premised on a legged mobile robot equipped with 
the foot 224 explained regarding the fourth embodiment. 

[0171] In the sixth embodiment, the friction brake 60 is operated to control the 
floor reaction force's moment during the tiptoe standing period. 

[0172] As the main points of difference from the earlier embodiments are in the 
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processing of the aforesaid foot compensating angle determiners 114c - 114f and the 
operation of the bending angle change suppressor, an explanation will be made with focus 
on these points in the following. 

[0173] FIG 30 is a time chart showing the transition of, inter alia, the control mode 

5 of the friction brake 60 according to the sixth embodiment. 

[0174] As shown in FIG 30, the control mode of the friction brake 60 according 
to this embodiment comprises three types: "LOCK," "CNTRL" and "SEMI-FREE." 
Further, the compliance control mode (explained later) comprises three types: 
"HOLD," "CNTRL" and "RET." 

10 [0175] FIG 31 is a block diagram showing the processing of the compensating 

angle determiner of the legged mobile robot control system according to the sixth 
embodiment. Note that the 1st foot X-compensating angle 01x, 1st foot Y-compensating 
angle 91y, 2nd foot X-compensating angle 92x and 2nd foot Y-compensating angle 02y are 
all determined by the same algorithm and, therefore, mention of the leg serial numbers (n: 

15 1,2) and X, Y is omitted in the following. 

[0176] What characterizes the processing shown in FIG 31 is that a select switch 
130 is provided and the input of an integrator 132 is switched in accordance with the 
compliance control mode. 

[0177] To begin with, an explanation will be made regarding the processing when 
20 "CNTRL" is selected as the compliance control mode (the select switch 130 is 

connected to the "CNTRL" side). First, the actual foot floor reaction force's moment 

Mact is passed through a low-pass filter 134 for preventing oscillation to obtain Mactfilt. 

Further, the foot compensating moment Mdmd is passed through a compensating filter 

136 to subtract it fi-om Mactfilt and obtain the deviational moment MdiflF. Like the one 
25 shown in FIG 12, the compensating filter 136 is for enhancing the fi-equency response 

characteristic of the transfer function fi-om the foot compensating moment Mdmd to the 

actual total floor reaction force. 

[01 78] The deviational moment MdiflF is then multiplied by K_cmpl (control gain) to 

determine a compliance control compensating demand angle Gcmpl dmd, which after 
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being diflferentiated by a differentiator 138, is further integrated by the integrator 132 to 
obtain a compliance control compensating angle Gcmpl. 

[0179] Next, similarly to the processing shown in FIG 12, the feet deformation 
compensating angle Off is determined and added to the compliance control compensating 
5 angle 9cmpl to obtain the foot compensating angle 9. 

[0180] Note that the compliance control compensating angle Ocmpl is substantially 
equal to the compliance control compensating demand angle 0cmpl_dmd because before 
entering the "CNTRL" mode it is substantially zero in the "RET" mode explained next. 
[0181] Next, an explanation will be made regarding the processing when "RET" is 

10 selected as the compliance control mode. When "RET" is selected as the compliance 
control mode, the select switch 130 is connected to the RET side, so that the value 
obtained by multiplying the compliance control compensating angle Ocmpl by -K_ret is 
inputted to the integrator 132. As a result, the change rate of the compliance control 
compensating angle Ocmpl becomes -K_ret * Ocmpl. That is, the compliance control 

15 compensating angle Ocmpl gradually returns to zero by the step response of a first-order 
delay system of time constant 1/K_ret. 

[0182] On the other hand, when "HOLD" is selected as the compliance control 

mode, the select switch 130 is connected to the HOLD side, so that zero is inputted to the 
integrator 132. That is, the value up to then is held as the compliance control compensating 
20 angle Ocmpl. 

[0183] Next, an explanation will be made regarding the hydraulic control of the 
friction brake 60 in accordance with tfie sixth embodiment. FIG 32 is a block diagram 
showing the processing of this control. 

[0184] To explain FIG 32, first, the actual foot floor reaction force's moment Mact is 

25 passed through a low-pass filter 1 40 for preventing oscillation to obtain Mactfilt. Further, 
the foot compensating moment Mdmd is passed through a compensating filter 142 for 
frequency response characteristic enhancement to subtract it from Mactfilt and obtain the 
deviational moment Mdiff. 

[0185] Next, the deviational moment MdiflF is multiplied by K_b (control gain) to 
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determine a pressure demand P_dmd and the value obtained by adding an offset pressure 
P offset thereto is outputted to the hydraulic pressure generating unit as the pressure 
command P_b. 

[0186] Note that the foregoing is the processing when, as illustrated, "CNTRL" has 
5 been selected as the friction brake control mode and a select switch 144 is connected to the 
CNTRL side; and when "LOCK" or "SEMI-FREE" has been selected, then similarly to in 
the fourth embodiment, P_high (bending angle holding command) or P low (held bending 
angle releasing command) is outputted to the hydraulic pressure generating unit through 
the select switch 144 as the hydraulic command P_b. 

10 [0187] To explain the FIG 30 time chart in light of the foregoing, "HOLD" is 

selected as the compliance control mode between the fourth time point t4 and fifth time 
pomt t5 after liftoff. Further, "RET" is selected between the fifth time point t5 and sixth 
time point t6 before landing of the leg 2 (i.e., for a given part of swing). Further, "CNTRL" 
is selected between the sixth time point t6 and fourth time point t4 of the next cycle (i.e., 

15 from before landing of the leg 2 to completion of flat ground contact (start of tiptoe 
standing). 

[0188] To explain this more spefically, ordinary compliance control is conducted 

between the sixth time point t6 before the leg 2 lands and the fourth time point t4 at which 
flat grovind contact is completed. On the other hand, the compliance control compensating 

20 angle Gcmpl at the time of flat ground contact completion is held between the fourth time 
point t4 at which the robot 1 begins tiptoe standing and the fifth time point t5 at which the 
leg 2 lifts off (i.e., for a period including at least the tiptoe standing period). Then, in 
preparation for compliance control in the next cycle, the compliance control compensating 
angle Gcmpl is returned to zero during the liftoflF period between the fifth time point t5 and 

25 sixth time point t6 of the next cycle. 

[0189] What is characteristic here, is that the control mode of the fiiction brake 60 is 
set to "CNTRL" between the fourth time point t4 and first time point tl of the next cycle 
(i.e., during the tiptoe standing period). That is, during this period, instead of conducting 
ordinary compliance control, the hydraulic pressure supplied to the fiiction brake 60 is 
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controlled to regulate its frictional force, thereby regulating the bending angle of the toe 
224t to control the floor reaction force's moment. As a result, posture stability during the 
tiptoe standing period can be further enhanced. 

[0190] Note that explanation of the remainder of the configuration is omitted 
5 because it is the same as that of the earlier embodiments. However, differently from the 
earlier embodiments, the sixth embodiment does not necessarily require the first time 
point tl to be different between when the robot 1 is moving over flat terrain and when it 
is climbing stairs, because the configuration is such that the bending angle of the toe 
224t is regulated to control the floor reaction force's moment during the tiptoe standing 
1 0 period. 

[0191] Further, although the sixth embodiment has bee explained premised on the 
legged mobile robot according to the fourth embodiment, it can also be applied to the 
legged mobile robots of the other embodiments provided that the friction brake 60 is 
provided on the foot. 

15 

Seventh embodiment 

[0192] A legged mobile robot and control system thereof according to a seventh 
embodiment of this invention will next be explained with reference to FIGs. 33 and 34. 
Note that the following explanation is premised on a legged mobile robot equipped with 

20 the foot 22 explained regarding the first embodiment. 

[0193] The damping characteristic of the damper 50 (i.e., the magnitude of the 

resistance produced by the damper 50; in other words, the bending angle change 
suppressing force) can be regulated as desired by operating the electromagnetic solenoid 
50e to vary the opening area of the orifice 50d. So in the seventh embodiment, during 

25 the tiptoe standing period, the damping characteristic of the damper 50 is regulated to 
regulate the bending angle of the toe 22t and thereby control the floor reaction force's 
moment. 

[0194] FIG, 33 is a time chart showing the transition of, inter alia, the control 
mode of the damper 50 according to the seventh embodiment. 



-37- 



[0195] As shown in FIG 33, the damper control mode according to this 
embodiment comprises three types: "CLOSE," "CNTRL" and "OPEN." Further, as in 
the sixth embodiment, the compliance control mode comprises three types: "HOLD," 
"CNTRL" and "RET." 

5 [0196] An explanation regarding the points of difference from the sixth 
embodiment will be made in the following. FIG. 34 is a block diagram showing the 
damper 50 throttling control processing according to the seventh embodiment. 
[0197] As shown in FIG 34, first, the actual foot floor reaction force's moment 
Mact is passed through a low-pass filter 150 for preventing oscillation to obtain Mactfilt. 
10 Further, the foot compensating moment Mdmd is passed through a compensating filter 
152 for fi*equency response characteristic enhancement to subtract it fi-om Mactfilt and 
obtain the deviational moment MdifF. 

[0198] Next, the deviational moment Mdiff is multiplied by K_d (control gedn) to 
determine a damper throttling demand Rd_dmd and the value obtained by adding an offset 
1 5 throttling Rd_offset thereto is outputted to the damper 50 as a damper throttling command 
R_d. 

[0199] Note that the foregoing is the processing when, as illustrated, "CNTRL" has 
been selected as the damper control mode (a select switch 1 54 is connected to the CNTRL 
side); and when "CLOSE" or "OPEN" has been selected, then sunilarly to in the first 
20 embodiment, Rd_close (bending angle holding command) or Rd_open (held bending angle 
releasing command) is outputted to the damper 50 through the select switch 154 as the 
damper throttling command R_d. 

[0200] Further, although explanation will be omitted, the foot compensating angle 
determiner processing like that in FIG 31 of the aforesaid sixth embodiment is also 
25 performed in the seventh embodiment. 

[0201] To explain the FIG 33 time chart in light of the foregoing, the control mode 

of the damper 50 is, as illustrated, set to "CNTRL" between the fourth time point t4 and 
first time point tl of the next cycle (i.e., during the tiptoe standing period). Further, the 
compliance control mode is set to "HOLD" between the fourth time point t4 and fifth time 
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point t5, which interval includes the tiptoe standing period. That is, during the tiptoe 
standing period, instead of conducting compliance control, the electromagnetic solenoid 
50e is operated to vary the opening area of the orifice 50d, thereby regulating the damping 
characteristic of the damper 50 so as to regulate the bending angle of the toe 22t and thus 
5 control the floor reaction force's moment. As a result, similarly to in the sixth embodiment, 
posture stability during the tiptoe standing period can be further enhanced. 
[0202] Note that explanation of the remainder of the configuration is omitted 
because it is the same as that of the earlier embodiments. However, similarly to in the 
sixth embodiment, the seventh embodiment also does not necessarily require the first 
10 time point tl to be different between when the robot 1 is moving over flat terrain and 
when it is climbing stairs, because the configuration is such that the bending angle of 
the toe is regulated to control the floor reaction force's moment during the tiptoe 
standing period. 

[0203] Further, although the seventh embodiment has been explained premised on 
15 the legged mobile robot according to the first embodiment, it can also be applied to the 
legged mobile robots of the other embodiments provided that the damper 50 is provided 
on the foot. 

Eighth embodiment 

[0204] A legged mobile robot and control system thereof according to an eighth 
embodiment of this invention will next be explained with reference to FIGs. 35 and 36. 
Note that the following explanation is premised on a legged mobile robot equipped with 
the foot 223 explained regarding the third embodiment. 

[0205] As explained earlier, the damper 500 utilizes the flow resistance of a fluid. 
The flow resistance of a fluid depends on its flow velocity, and the flow velocity of the 
fluid in the damper 500 depends on the bending angular velocity of the toe 223t. That is, 
the damper 500 has a predetermined resistance characteristic set with respect to the 
bending angular velocity of the toe 223t. It can be said that the bending angle change of 
the toe 223t is suppressed in accordance with this resistance characteristic. In the eighth 
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embodiment, therefore, the magnitude of the resistance produced by the damper 500 is 
varied by manipulating the position/posture of the foot 223 to regulate the bending 
angular velocity of the toe 223t, thereby controlling the floor reaction force's moment. 
[0206] FIG 35 is a time chart showing the transition of, inter alia, the control 
5 mode of the damper 500 according to the eighth embodiment. 

[0207] As shown in FIG. 35, the bending angular velocity control mode (explained 
later) comprises three types: "HOLD," "CNTRL" and "RET." 

[0208] FIG. 36 is a block diagram showing the processing of the foot 

compensating angle determiner of the legged mobile robot control system according to 
10 the eighth embodiment. Note that for the same reason as in the sixth embodiment 
mentioning of the leg serial numbers (n: 1, 2) and X, Y is omitted in the following. 
[0209] As shown in FIG 36, the eighth embodiment is provided with a select switch 
160 and the input to an integrator 162 is switched in accordance with the bending angle 
velocity control mode. 

15 [0210] To begin with, an explanation wall be made regarding the processing when 
"CNTRL" is selected as the bending angular velocity control mode (the select switch 
160 is connected to the "CNTRL" side). First, the actual foot floor reaction force's 
moment Mact is passed through a low-pass filter 164 for preventing oscillation to obtain 
Mactfilt. Further, the foot compensating moment Mdmd is passed through a 

20 compensating filter 166 for fi-equency response characteristic enhancement to subtract it 
from Mactfilt and obtain the deviational moment MdiflF. 

[0211] Then the value obtained by multiplying the deviational moment Mdiff by 

D_cntrl (control gain) is integrated by the integrator 162 to determine a damper control 
compensating angle Odcntrl. Further, the deviational moment MdiflF is multiplied by 
25 K cmpl (control gain) to obtain the aforesaid compliance control compensating angle 
Gcmpl. 

[0212] Finally, the value obtained by adding together the damper control 
compensating angle Gdcntrl and compliance control compensating angle Ocmpl is, 
similarly to in the sixth embodiment, fiirther added to the determined foot deformation 
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compensating angle Gff to obtain the foot compensating angle 0. The joint displacement of 
the robot 1 is manipulated based on this foot compensating angle 9 so as to manipulate the 
position/posture of the foot 223, thereby varying the angular velocity of the foot 223 
relative to the floor, i.e., regulating the bending angular velocity of the toe 223t to vary the 
5 magnitude of the resistance produced by the damper 500, and thus control the floor 
reaction force's moment. Note that rather than manipulating the joint displacement it is also 
acceptable to manipulate the position/posture of the foot 223 by manipulating the robot 1 
gait itself. 

[0213] Next, an explanation will be made regarding the processing when "RET" is 
10 selected as the bending angular velocity control mode. When "RET" is selected as the 
bending angular velocity control mode, the select switch 160 is connected to the RET 
side, so that the value obtained by multiplying the damper control compensating angle 
Gdcntrl by -K ret is inputted to the integrator 162. As a result, the change rate of the 
damper control compensating angle Odcntrl becomes -K_ret * Odcntrl. That is, the damper 
15 control compensating angle Odcntrl gradually returns to zero by the step response of a 
first-order delay system of time constant 1/K_ret. 

[0214] On the other hand, when "HOLD" is selected as the bending angular velocity 

control mode, the select switch 160 is connected to the HOLD side, so that zero is inputted 
to the integrator 162. That is, the value up to then is held as the damper control 

20 compensating angle Odcntrl. 

[0215] Note tiiat explanation regarding the hydraulic control of the fiiction brake 60 
is omitted because it is the same as that of the third embodiment (FIG 20). 
[0216] To explain the FIG 35 time chart in light of the foregoing, "CNTRL" is 
selected as the bending angular velocity control mode between the fourth time point t4 

25 and first time point tl of the next cycle (i.e., during the tiptoe standing period). Further, 
"HOLD" is selected between the first time point tl and seventh time point t7 during 
swing. Further, "RET" is selected between the seventh time point t7 and fourth time 
point t4 (i.e., from before landing of the leg 2 to completion of flat groimd contact (start 
of tiptoe standing)). 
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[0217] Dviring the tiptoe standing period in which "CNTRL" is selected as the 
bending angular velocity control mode, "FREE" is selected as the friction brake control 
mode £ind the toe 223t is made bendable. That is, during this period the position/posture 
of the foot 223 is varied to regulate the bending angular velocity of the toe 223t, thereby 
5 manipulating the magnitude of the resistance produced by the damper 500 to control the 
floor reaction force's moment. As a result, posture stability during the tiptoe standing 
period can be further enhanced. 

[0218] Note that explanation of the remainder of the configuration is omitted 
because it is the same as that of the earlier embodiments. However, similarly to in the 
10 sixth embodiment, the eighth embodiment also does not necessarily require the first 
time point tl to be different between when the robot 1 is moving over flat terrain and 
when it is climbing stairs, because the configuration is such that the bending angle of 
the toe is regulated to control the floor reaction force's moment during the tiptoe 
standing period. 

15 [0219] Further, although the eighth embodiment has been explained premised on 
the legged mobile robot according to the third embodiment, it can also be applied to the 
legged mobile robots of the other embodiments that are equipped on the foot with the 
damper 50 (damper with electromagnetic solenoid). 

20 Ninth embodiment 

[0220] A legged mobile robot and control system thereof according to a ninth 

embodiment of this invention will next be explained with reference to FIG. 37. 
[0221] The ninth embodiment is what is obtained by applying to the legged 
mobile robot according to the fifth embodiment, which is equipped with the sensor for 

25 detecting the toe bending angle, the technique set out in Japanese Laid-open Patent 
Application 2000-147948 proposed earlier by the applicant (technique for estimating 
floor shape) and the control explained in the sixth embodiment. 

[0222] FIG. 37 is a block diagram showing the processing of the foot 
compensating angle determiner of the legged mobile robot control system according to the 
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ninth embodiment. Note that for the same reason as in the sixth embodiment mentioning of 
the leg serial numbers (n: 1, 2) and X, Y is omitted in the following. 

[0223] As shown in FIG 37, the ninth embodiment has a floor shape estimator 
170 incorporated in the foot compensating angle determiner described in the sixth 
5 embodiment (shown affixed with the same symbols as the sixth embodiment). 

[0224] The processing shown in FIG. 37 will be explained in the following: to the 
sum of the compliance control compensating angle Gcmpl and foot deformation 
compensating angle 9flf calculated by processing similar to that of the sixth embodiment is 
further added with an estimated foot floor inclination deviation Gfestm outputted from the 

10 floor shape estimator 1 70, thereby determining the foot compensating angle 0. 

[0225] The floor shape estimator 170 is inputted with, in addition to the foot 
compensating angle 9 determined in the foregoing manner, the actual foot floor reaction 
force Fact, Mact, the body inclination angle error Gerr, the bending angle of the toe 22t 
detected by the stroke sensor 22s or rotation angle sensor 222s, and so forth. Based on 

15 these, the floor shape estimator 170 calculates and outputs a floor shape estimated value 
(specifically, an estimated foot floor inclination difference Gfestm and an estimated 
foot-to-foot floor inclination diSerence Gfdbestmv to be used for calculating the feet 
compensating angle Gdbv mentioned in the first embodiment). Note that explanation 
regarding the operation of the floor shape estimator 170 is omitted because it is elaborately 

20 covered in the aforesaid Japanese Laid-open Patent Application 2000- 1 47948 . 

[0226] Thus in the ninth embodiment the floor shape estimated value is calculated 
based on the toe bending angle and the like and the value is added as a parameter used 
to calculate the foot compensating angle G (and the feet compensating angle Gdbv). More 
generally, the shape of the floor on which the robot 1 walks is estimated, and the bending 

25 angle change suppressor is operated based on the estimated floor shape etc. so as to control 
the floor reaction forceps moment. As a result, stability during the tiptoe standing period 
can be further enhanced. Further, performance at higher accuracy than by ordinary 
compliance control is possible. 

[0227] Note that although in the ninth embodiment the floor shape estimator 170 
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is incorporated in the foot compensating angle determiner explained in the sixth 
embodiment, it is also acceptable to incorporate it in the foot compensating angle 
determiners explained in the other embodiments. 

[0228] In the first to ninth embodiments of this invention are configured to have a 
5 legged mobile robot (1) having a body (24) and legs (2R, 2L) whose upper ends are 
connected to the body and whose lower ends are each connected to a foot (22, 222, 223, 
224) to be movable when the legs are driven, characterized in that the foot comprises a 
foot main body (22m, 222m, 223m, 224m) connected to each of the legs, a toe (22t, 
222t, 223t, 224t) provided at a fore end of the foot main body to be bendable with 

10 respect to the foot main body, and a bending angle holder (damper 50, friction brake 60) 
capable of holding a bending angle (0t) of the toe in a bendable range of the toe. 
[0229] Further, they are configured to further include a bending angle change 
suppressor (damper 50, damper 500, friction brake 60) that suppresses change of the 
bending angle of the toe. 

15 [0230] Further, the first embodiment and the third to ninth embodiments are 
configured such that the toe (22t, 223t, 224t) is made continuous with the foot main 
body (22m, 223m, 224m) and is made of an elastic material that bends with flexing. 
[0231] Further, the second to ninth embodiments are configured such that the toe 
(222t, 223t, 224t) is connected to the fore end of the foot main body through a rotational 

20 shaft (222a) capable of rotating about a pitch axis. 

[0232] Further, the second to ninth embodiments are configured to further include 
an urging means (restoring spring 222b) for urging the toe in a direction of restoring it 
to an initial position. 

[0233] Further, the third to sixth embodiments are configured such that the 
25 bending angle holder comprises a friction brake (60). 

[0234] Further, the first, second, third, fifth, seventh, eighth and ninth 
embodiments are configured such that the bending angle change suppressor comprises a 
damper (50, 500). 

[0235] Further, the fourth, sixth and ninth embodiments are configured such that 
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the bending angle holder and the bending angle change suppressor comprise a friction 
brake (60) whose frictional force is made adjustable. 

[0236] Further, the first, second fifth, seventh and ninth embodiments are 
configured such that the bending angle holder and the bending angle change suppressor 
5 comprise a damper (50). 

[0237] Further, the first to ninth embodiments are configured to have a system for 
controlling a legged mobile robot having a body (24) and legs (2R, 2L) whose upper 
ends are connected to the body and whose lower ends are each cormected to a foot (22, 
222, 223, 224) to be movable when the legs are driven, the foot having a foot main body 

10 (22m, 222m, 223m, 224m) connected to each of the legs and a toe (22t, 222t, 223t, 
224t) provided at a fore end of the foot main body to be bendable with respect to the 
foot main body, characterized by a bending angle holder (damper 50, friction brake 60) 
capable of holding a bending angle (9t) of the toe in a bendable range of the toe, and a 
bending angle controlling means (control unit 26) for operating the bending angle 

15 holder to control holding and releasing of the bending angle of the toe, the bending 
angle controlling means holding the bending angle of the toe at a first time point (tl) 
which is a liftoff time of the leg from a floor or earlier thereof, and releasing the held 
bending angle of the toe at a second time point (t2) after the leg has lifted off the floor 
to restore the toe to a initial position. 

20 [0238] Further, the first to fourth embodiments and the sixth to ninth embodiments 
are configured to further include a gait generating means (gait generator 100) for 
generating a gait of the robot, and the bending angle controlling means determines the 
first time point and the second time point based on the generated gait. 
[0239] Further, the fifth to ninth embodiments are configured to further include a 

25 bending angle detecting means (stroke sensor 22s, rotation angle sensor 222s) for 
detecting the bending angle of the toe (22t, 222t), and a gait generating means (gait 
generator 100) for generating a gait of the robot, and the bending angle controlling 
means determines the first time point based on the detected bending angle and 
determines the second time point based on the generated gait. 
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[0240] Further, the first to ninth embodiments are configured such that the bending 
angle controlling means holds the bending angle of the toe at a third time point (t3) 
during liftoff of the leg from the floor, which is later than the second time point, and 
releasing the held bending angle of the toe at a fourth time point (t4), after the leg has 
5 landed on the floor, which is earlier than the first time point at a next time. 

[0241] Further, the first to fourth embodiments and the sixth to ninth embodiments 
are configured to fiirther include a gait generating means (gait generator 100) for 
generating a gait of the robot, and the bending angle controlling means determines the 
first to fourth time points based on the generated gait. 

10 [0242] Further, the fifth to ninth embodiments are configured to fiirther include a 
bending angle detecting means (stroke sensor 22s, rotation angle sensor 222s) for 
detecting the bending angle of the toe (22t, 222t), and a gait generating means (gait 
generator 100) for generating a gait of the robot and the bending angle controlling 
means determines the first and third time points based on the detected bending angle, 

15 and determines the second and fourth time points based on the generated gait. 

[0243] Further, the fourth embodiment is configured to further include a bending 
angle change suppressor (friction brake 60) that suppresses change of the bending angle 
of the toe (224t), and the bending angle controlling means releases the held bending 
angle of the toe at the second time point to gradually restore the toe to the initial 

20 position by operating the bending angle change suppressor to reduce the bending angle 
progressively. 

[0244] Further, the six, seventh and ninth embodiments are configured to further 
include a bending angle change suppressor (damper 50, fnction brake 60) that 
suppresses change of the bending angle of the toe, and the bending angle controlling 
25 means operates the bending angle change suppressor from the fourth time point to the 
first time point at the next time to control a floor reaction force (floor reaction force's 
moment) acting to the robot through the foot. 

[0245] Further, the eighth embodiment is configured to further include a bending 
angle change suppressor (damper 500) that suppresses change of the bending angle of 
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the toe in accordance with a predetermined resistance characteristic set with respect to 
angular velocity of the bending angle, and the bending angle controlling means 
manipulates a position or posture of the foot (22R(L)) from the fourth time point to the 
first time point at the next time to regulate the bending angular velocity of the toe, 
5 thereby varying magnitude of resistance produced by the bending angle change 
suppressor to control a floor reaction force (floor reaction force's moment) acting to the 
robot through the foot. 

[0246] Further, the ninth embodiment is configured to further include a bending 
angle change suppressor (damper 50, friction brake 60) that suppresses change of the 

10 bending angle of the toe; a bending angle detecting means (stroke sensor 22s, rotation 
angle sensor 222s) for detecting the bending angle of the toe, and a floor shape 
estimating means (floor shape estimator 170) for estimating shape of the floor on which 
the foot is based on at least the detected bending angle, and the bending angle 
controlling means operates the bending angle change suppressor from the fourth time 

1 5 point to the first time point at the next time based on at least the estimated shape of the 
floor to control a floor reaction force (floor reaction force's moment) acting to the robot 
through the foot. 

[0247] Note that although in the foregoing the compliance mechanism 42R(L) 
required for cushioning impact at floor contact and enhancing control performance is 
20 constituted of the spring mechanism unit 38R(L) and sole 40R(L), it is also possible, for 
example, to provide a leaf spring on the bottom of the foot and utilize its elasticity. As the 
material of the leaf spring, carbon or the like imparted vsdth elasticity is preferable from the 
viewpoint of weight reduction. 

[0248] Further, although a damper and a friction brake have been given as 
25 examples of the bending angle holder for holding the bending angle of the toe and the 
bending angle change suppressor for suppressing the bending angle change, they are of 
course not limited to these. For example, it is possible to use a ratchet mechanism as the 
bending angle holder. When a damper or friction brake is used as the bending angle 
holder, the bending angle can be held anjwhere in the continuum of angles within the 
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movable range of the toe. In contrast, in the case of a ratchet mechanism, the angle is 
held at any among multiple angles corresponding to the number of gears of the ratchet 
(i.e., holding within the range of the ratchet feed angle is not possible, so that the 
angles the ratchet mechanism can hold are not continuous), but there is the merit of no 
operation being necessary at the time of holding the bending angle. 

INDUSTRIAL APPLICABILITY 
[0249] According to this invention, in a legged mobile robot, the configuration is 
such that each foot comprises a foot main body and a bendable toe provided at the fore 
end of the foot main body, and a bending angle holder capable of holding the bending 
angle of the toe is provided. Further, in a control system of the legged mobile robot, the 
configuration is such that the bending angle of the toe is held at a first time point at the 
liftoff time of the leg or prior thereto and the toe is restored to the initial position at a 
second time point after the leg lifts off". As a result, the bending angle at the time of 
liftoff can continue to be held even after the leg lifts off, whereby the posture can be 
prevented fi-om becoming unstable owdng to the toe contacting the floor immediately after 
liftoflF. Further stability during tiptoe standing can be enhanced. 
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